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@ A servo controller which, when the rotational 
direction of the servo motor is inverted, adds back- 
lash correction data (Be) to position deviation data 
(Pc) to generate a speed instruction (Vcmd) and adds 
backlash acceleration quantity (Bacc) to the speed 
instruction to correct backlash. In order to terminate 
the backlash acceleration at a suitable timing, a 
counter (19) adds up the speed feedback pulses 
from a moment when the acceleration control is 
started, an acceleration stop instruction unit (20) 
monitors the added-up value of the speed feedback 
pulses, and an acceleration quantity output unit (21) 
no more produces the backlash acceleration quantity 
(Bacc) when the added-up value has reached a pre- 
determined value such as 2 or 3, thereby to com- 
plete the backlash acceleration control operation. 
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DESCRIPTION 
SERVO -CONTROL APPARATUS 

Technical Field 

This invention relates to a servo -control apparatus 
5 and, more particularly, to a servo -control apparatus 

capable of performing a backlash correction rapidly and 
of reducing quadrant projections produced as a result of 
friction and backlash. 
Background Art 

10 In order to correct for backlash of gears or the 

like when the direction of rotation of a servomotor 
controlling the feed shaft of a machine tool is 
reversed, or in other words, when the direction of 
travel of the movable element of the machine is 

15 reversed, preset baclclash correction data is applied to 
position error data to generate a velocity command, and 
the rotation of the servomotor is controlled based on 
the velocity command. However, since the backlash 
correction data acrs upon a velocity loop through a 

20 predetermined position gain Kp, the machine does not 

move immediately because of a delay in the servo -system. 
As a consequence, a quadrant projection is produced at 
the location where the direction of machining is 
reversed • 

25 Accordingly, in order to diminish the effects of 

backlash and friccion and reduce projections at quadrant 
changeover points at the time of cutting, it has been 
prcpcsed to apply a suicable amount of acceleration 
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(referred to as "backlash acceleration") to the velocity 
coininand for a prescribed period of time. However , when 
an NC unit effects backlash correction at the same time 
that the backlash correction data is delivered to the 
servo side, the motor is not completely reversed in 
direction owing to the delay between the command and the 
servo -system- The unfortunate result is that bite- in is 
caused on the inner side. In actuality^ therefore^ the 
direction in which the motor rotates is monitored and 
backlash acceleration is applied at the timing of the 
reversal in direction of rotation. When control of 
backlash acceleration is carried out at the time of the 
reversal in motor direction, the occurrence of quadrant 
projections caused by backlash and friction in the 
machine system can be reduced considerably. 

There are cases where the effect of a sudden change 
in velocity at the end of acceleration shows up at the 
cut surface in the form of inadequate smoothness if the 
amount of backlash acceleration is made constant over 
the entire period of application. Accordingly^ it has 
been proposed to. enlarge the amount of backlash 
acceleration at the start of acceleration in order to 
prevent inadequate acceleration, and thereafter reduce 
the amount of acceleration gradually with the passage of 
time to prevent a sudden change in velocity when 
backlash acceleration ends . 

However, the backlash acceleration algorithm itself 
is open-loop control, and it is required that parameters 
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(the amount of backlash acceleration, backlash 
acceleration time, etc.) be set accurately for each and 
every machine. 

In addition^ optimum parameters change depending 
5 upon cutting velocity, workpiece weight, temperature, 
the condition of the cut surface, etc. Consequently, 
even if quadrant projections can be made very small 
under certain conditions, these projections can enlarge 
or cut-in can result on the inner side when cutting is 

10 performed under other conditions. 

Accordingly, an object of the present invention is 
to provide a servo -control apparatus capable of 
eliminating backlash with the same parameters even if 
machine conditions and cutting conditions change, 

15 thereby making it possible to eliminate quadrant 
projections . 

Toother object of the present invention is to 
provide a servo -control apparatus capable of ending 
backlash acceleration at an optimum timing, whereby the 

2 0 amount of backlash acceleration can be made a suitable 
value and quadrant projections can be eliminated. 
Disclosure of the Invention 

In accordance with the present invention, the 
foregoing objects are attained by monitoring the 

25 accumulated value of velocity feedback and stopping 

backlash acceleration when che accumulated value becomes 
equal to a predetermined value. 
Brief Descrioticn of the Drawings 
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Fig, 1 is a block diagram of a servo -control 
apparatus according to the present invention; and 

Fig. 2 shows the results of measurement in a case 
where a machine tool is made to cut a perfect circle 
5 using the servo -control apparatus according to the 
present invention. 

Best Mode for Carrvino Out the Invention 

Fig- 1 is a block diagram of a servo -control 
apparatus according to the present invention, Nximeral 

1 0 11 denotes an NC unit which generates a move command Pc 
every predetermined sampling time Ts, and which outputs 
an amount of backlash correction Be when there is a 
reversal in the direction of the move command. Numeral 
12 denotes a position error arithmetic unit for 

1 5 computing a difference between the move command Pc and a 
detected amount of movement Pa every sampling time. - 
Nxjineral 13 designates an error counter for accixmulating 
the difference in accordance with the equation 
Er + (Pc - Pa) Er 

20 and outputting a position error E^. Numeral 15 denotes 
a velocity controller for outputting a torque command 
based on the difference between a velocity command Vcao' 
and velocity feedback (actual velocity) V^. Numeral 16 
represents an arithmetic unit for computing a frictional 

25 torque Tf from a torque command Tcmd outputted by the 
velocity controller 15. Shown at numeral 17 is a 
machine system including a servomotor, which is the 
object controlled, a pulse coder, etc. The machine 
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system 17 is expressed by a transfer function (Jm 
represents motor inertia) • 

Numeral 18 denotes a backlash correction timing 
discriminator, and 19 a counter to which pulses 
generated by a pulse coder (not shown) are applied as 
the velocity feedback V^^^ in order to be counted during 
each sampling time period Ts . Numeral 20 denotes an 
acceleration- stop instructing unit for monitoring the 
accumulated value in the counter and outputting an 
acceleration- stop signal AS? when the accumulated value 
attains a predetermined value, e.g,, 2 - 3. Niimeral 21 " 
denotes a unit for outputting the amount of 
acceleration. Poi adder for adding the amount of 
backlash acceleration is shown at numeral 22. 

The backlash correction timing discriminator 18 
stores and holds the amount of backlash correction Be 
supplied by the NC unit 11 when the direction of the 
move command is reversed. In addition, the 
discriminator 18 monitors the content (position error) 
of the error counter 13 and detects the reversal in 
the direction of rotation of the servomotor in response 
to Er = 0 . In response to detection of the reversal in 
direction of rotation, the discriminator 18 outputs the 
amount of backlash correction 3c to an adder 20, outputs 
a signal RDI indicative of the reversal in rotational 
direction to the acceleration output unit 21, and 
outputs a counter reset signal RST. 

The acceleration output unit 21 outputs an amount 
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of backlash acceleration Bacc when the position error 
becomes zero (RDI = "1") , and terminates the output of 
the backlash acceleration when the accumulated value of 
velocity backlash becomes equal to a predetermined 
5 value (ASP = "1") . 

The overall operation of the apparatus of Fig. 1 
will now be described. 

The difference, which is calculated in the 
arithmetic unit 12, between the move command Pc and • 

1 0 detected amount of movement every sampling time Ts is 
integrated by the error counter 13 to obtain the 
position error Ef/ after which the position error is 
multiplied by the position gain Kp to provide the 
velocity command Vcj^q. The velocity controller 15 

15 subsequently outputs the torque command Tcmd conforming 
to a velocity error, thereby rotating the servomotor. 

When the direction of commanded movement is 
reversed under these conditions, the preset amount of 
backlash Be is outputted by the NC unit 11, and the 

20 latter generates a move command PC in the reversed 
direction every sampling time Ts- 

The backlash correction timing discriminator 18 
holds the abovementioned amount of backlash correction 
Be and subsequently monitors the content (position 

25 error) of the error counter 13 in parallel with the 
servo -control processing described above. When the 
condition Er = 0 is established, it is determined chat 
the servomotor has reversed direction. 
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In response to detection of the reversal in 
rotational direction, the discriminator 18 outputs the 
held backlash correction 3c to the adder 20, outputs the 
rotational direction reversal signal RDI to the 
5 acceleration output unit 21 and outputs the counter 

reset signal RST to reset the content of counter 19 to 
zero . 

The backlash correction adder 20 adds the backlash 
correction Be and the position error and applies the 

10 result to the position gain setting unit 14, The latter 
nxultiplies the result by the position gain Kp to 
generate the velocity command Vcmd conforming to the 
amount of backlash correction- 

The acceleration output unit 21 outputs a constant 

15 amount of backlash acceleration Bacc in response to the 
rotational direction reversal signal RDI. As a result, 
the adder 22 adds the amount of backlash acceleration 
Eacc ^nd the velocity command Vcmd a-nd applies the sum to 
the velocity controller 15 as the true velocity command 

20 Vcmd'. 

The velocity controller 15 computes the velocity 
error and outputs the torque command TCMD conforming to 
this velocity error, thereby rotating the servomotor 17 
to rapidly correct backlash. 
25 In parallel with the foregoing processing^ the 

counter 19 accijmulates the velocity feedback VA from the 
moment acceleration control begins (i.e., from the 
moment Sr = 0 is established) . That is, the counter 19 
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receives, as the velocity feedback V^, the pulses 
generated by a pulse coder (not shown) and counts these 
pulses during each sampling time period Ts of digital 
servo -processing . 
5 The acceleration- stop instructing unit 20 monitors 

the acciamulated value in the counter 19 and outputs the 
acceleration- stop signal ASP when the accumulated value 
attains a predetermined value, e.g, . 2-3. This causes 
the acceleration output unit 21 to stop output ting the 

10 backlash acceleration signal Bacc/ thereby completing 
backlash acceleration control. 

The reason for terminating backlash acceleration 
when the accumulated value reaches 2 - 3 is as follows: 
In digital servo -control, the sampling time Ts is 

15 on the order of 1 msec, and spatial resolution of the 
servomotor, which is dependent upon the resolution of 
the pulse coder, is on the order of 10,000/rev. 
Velocity is very low when the servomotor reverses 
direction (i.e., at the start of acceleration control). 

20 Consequently, the number of feedback pulses (velocity . 
feedback) every sampling time is usually zero and 
sometimes attains a value, of one. Therefore, when it is 
detected that the velocity feedback has attained a 
value of one and backlash acceleration is teririinated, 

25 termination timing is too soon, a sufficient backlash 

acceleration cannot be applied and quadrant projections 
cannot be eliminated. Further, in an arrangement where 
backlash acceleration is terminated upon detecting that 
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the condition = 1 has been established, the 
termination of backlash acceleration will occur if the 
condition VA = 1 is established due to slight vibration 
in the motor for some reason (such as an external 
disturbance or unsteady current) . As a result, the 
amount of acceleration will be greatly inadequate and 
backlash acceleration control will lose its meaning. 

On the other hand, if backlash acceleration is 
terminated after the number of feedback pulses (velocity 
feedback) in the sampling time Ts is detected to have 
attained a value of two, the rotational velocity at this 
time will be 12 rpm. As a result, the timing for 
terminating acceleration will be too late, backlash 
acceleration will be excessive and cut-in will occur on 
the inner side. 

Accordingly, in the present invention, the 
arrangement is such that the acciamulated value of the 
velocity feedback is monitored and backlash 
acceleration is terminated when the accumulated value 
becomes 2-3. With such an arrangement, timing for 
ending backlash acceleration can be made that at which 
the amount of backlash acceleration attains the optimum 
value without being hastened or retarded excessively and 
irrespective of some variation in load conditions, a 
variation in cutting velocity, etc. 

Fig. 2 shows the results of measurement in a case 
where a machine tool is made to cut a perfect circle 
using the servo -control apparatus according to the 
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present invention. The dashed line indicates a true 
circle / and numerals 1, 2 indicate the results of 
measurement for a case where cutting is performed in 
clockwise and counter-clockwise directions, 
5. respectively. Quadrant projections and cut-in on the 
inner side are eliminated at quadrant changeover points 
3a - 3d. 

Thus / in accordance with the present invention, it 
is arranged to start backlash acceleration when the 

1 0 direction of servomotor rotation is reversed and end 
backlash acceleration when the accumulated value of 
velocity feedback becomes equal to a predetermined value 
of 2 - 3. As a result, timing for ending backlash 
acceleration can be made that at which the amount of 

15 backlash acceleration attains the optimum value without 
being hastened or retarded excessively and irrespective 
of some variation in load conditions, a variation in 
cutting velocity, etc. This makes it possible to 
eliminate quadrant projections and cut-in on the inner 

20 side. 
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CLAIMS : 

1. A servo -control apparatus for generating a velocity 
command by applying backlash correction data to position 
error data when direction of rotation of a servomotor is 
5 reversed, and performing a backlash correction by adding 
an amount of backlash acceleration to said velocity 
command, characterized by comprising: 

means for detecting reversal of the direction of 
rotation of the servomotor; 

1 0 detecting m.eans for detecting that an accumulated 

value of velocity feedback has become equal to a 
predetermined value after backlash acceleration is 
started; and 

acceleration output means for outputting the amount 
15 of backlash acceleration when direction of rotation of a 
servomotor is reversed, and terminating output of the 
amount of backlash acceleration when the accumulated 
value of velocity feedback becomes equal to the 
predetermined value, 

2 0 2. A servo -control apparatus according to claim 1, 

wherein said predetermined value is two or three. 
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